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Abstract of DE1 01 33624 

A device for ascertaining and calculating the 
corrected movement data for a specified 
sequence of movements of a movable device or 
tooling, has an image detection device, such as a 
digital camera (1 1 ) and a computer unit. The 
computer unit determines the corrected 
movement data via a reference device (9) 
according to controlled movement of the movable 
device. The reference device (9) shows 
unambiguous aspects of the image in a specified 
solid angle range, while the computer unit 
calculates a transformation specification for 
correction of the original movement data, from an 
actual image of the reference device (9) recorded 
by the image detection unit (1 1 ). 
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The invention concerns a device for the determination a course of motion of a movable mechanism, z given by corrected transaction data 
for. B. a displaceable robot, a linear axle system etc., after one of a controlling of the movable mechanism not or not sufficiently the one 
such device enclosure as well as a movable mechanism after the generic term of the requirement 1 and a system from several movable 
mechanisms seized movement of the movable mechanism, an arrangement. 



The German patent specification DE 32 46 828 C2 reveals a mobile transport and handling mechanism, which exist of an automatically 
controllable, line-bound and within the range of stop act ions roughly positionable corridor promotion vehicle as well as a robot connected 
firmly with the corridor promotion vehicle, which are steered by a computer. In the further one a measuring instrument is intended, whose 
components are partially stationarily in the range of the stop act ions appropriate partially at the mechanism and and are determinable by 
which after the positioning of the mechanism at the retaining position the deviation of the actual position of the corridor promotion vehicle 
from the target position. By means of the computer one takes place the deviation of the actual of value of the desired value corresponding 
transformation of the handling coordinates in robotic control. 



For the arrangement of the measuring instrument are a set of execution variants in the DE 32 46 828 C2 described. For example the 
measuring instrument exhibits a tracer with a plunger, which is at the grip arm of the robot attached and by this automatically to stationary 
points of reference or surfaces advancable. The actual position of the mechanism can be determined by touching these points or the 
surfaces. The moreover one becomes than measuring instrument a light emitter sends, a bundled ray of light diagonally on a reflecting 
measuring surface as well as a light receptor for the admission of the reflected jet suggested, whereby from the point of impact of the jet in 
the receiver the actual distance is determinable. 



The completely mechanical determination of the actual position by means of the grip arm has the disadvantage that the position can be 
determined only so exactly, how it permits the repetition accuracy of the mechanics. 



The optical determination of the actual position by a light emitter is to that extent unfavorable, for a three-dimensional collection of the 
position three measurements with differently in each case positioned transmitter are necessary, under what again the accuracy of the 
position collection suffers due to a limited mechanical repetition accuracy. 



Task and advantages of the invention 



A top Tne invention is the basis the task to be able comparatively more exactly and more economically to make the determination of corrected 
transaction data for a course of motion of a movable mechanism. 



This task is solved by the characteristics of the requirement 1, 6, 10 and 13. 



In the UnteransprCichen favourable and appropriate training further of the invention are indicated. 



The invention goes first from a device to the determination from corrected transaction data for a given course of motion of a movable 
mechanism, z. B. Elements of a displaceable robot or a system, consisting of several linear axles, after one of the controlling of the 
movable mechanism not or not sufficiently seized movement of the movable mechanism out. Core thought invention lies now in the fact 
that picture version unit and computer unit planned are and computer unit after one of control movable mechanism not or not sufficiently 
seized movement corrected transaction data by reference means certainly, which at least in given solid angle range clearly zuordenbare 
picture opinions exhibit, as the computer unit does not calculate insufficiently seized movement and data of a reference picture of the 
reference means, with which the movable mechanism would implement a desired movement accordingly from Urbewegungsdaten stored in 
the computer unit, by data of an actual picture of the reference means in the positioned condition of the movable mechanism, taken up by 
the picture version unit, after that or a transformation regulation for the correction of the Urbewegungsdaten. By this proceeding it is 
possible, by only one picture recording, not or not sufficiently seized spatial change of position of a movable mechanism at a measuring 
point accurately to determine. For this measuring point, which corresponds to a roughly started position, the correction data for all 
Urbewegungsdaten, in this connection determined, are relevant. D. h., which can accomplish movable mechanism at the measuring point 
with Urbewegungsdaten wished movements, which must be corrected only once with a transformation regulation. Into the DE described 
optical method it requires 32 46 828 the measurement of at least three different measuring points whereby the result of measurement is 
unfavorably affected by the repetition accuracy of the mechanical system for starting these measuring points. The measures according to 
invention have beyond that the further advantage that they can be realized in a comparatively clearly more compact design. The moreover 
one this kind of the transaction data correction makes by means of a picture version unit the employment the same picture version unit and 
the same computer unit for object recognition, if the device is arranged at a robot for example, for the z possible. B. given objects to seize 
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If the device according to invention is arranged for the determination of the spatial position for example at a displaceable robot with a 
transport vehicle without driver and a manipulator appropriate at the transport vehicle, this robot can after a rough positioning, z. B. over 
an inductive control system, trained courses of motion with corrected transaction data in the roughly positioned place (measuring point) 
nevertheless accurately accomplish and at the same time with the help of the picture version unit, z. B. workpieces, identify and if 
necessary in their situation, which can be worked on, recognize. D. h., in the case of a displaceable robot with manipulator it concerns a 
movable mechanism, i.e. the manipulator, those again movably and/or. is displaceable, because the manipulator is installed on a transport 
vehicle. In particular in such an arrangement the invention is favourable, since the transport vehicle can be brought by durable, fast 
working positioning means, which may be comparatively inaccurate, to a place of work, whereby a comparatively high accuracy of the 
movement of the manipulator is then reached by the adjustment of the Urbewegungsdaten of the manipulator on the place of work by 
means of the correction according to invention. The transport vehicle remains unchanged thereby in the roughly started employment 
position (measuring point). In order to receive an optimum correction of the path of a tool without mechanical influences, arranged at the 
manipulator, is suggested, positioning the picture version unit or the reference means directly at the tool. 



For the realization of a comparatively economical structure the picture version unit can cover a video camera, in particular a digital video 
camera. However also a similar or digital camera can be used. 



As computer unit a commercial PC can be used. 



In particular with the employment of a digital video camera it is preferential, if the computer unit is laid out in addition, intending the 
transformation regulation for the correction of transaction data by a pixel comparison of the actual picture with the reference picture. With 
the help of the transformation regulation then z can. B. a bionic arm, on the basis of origin transaction data, also after one of a controlling 
of the robot did not seize movement of the bionic arm on the basis from corrected transaction data in accurate way given courses of motion 
nevertheless accomplish. 



Preferably the computer unit is laid out for the determination of a transformation regulation in form of a shift vector in a three-dimensional 
coordinate system as well as of angle rotations around the three axes of coordinates, which stretch the coordinate system. By the shift 
vector and respective angle of rotation the movement of a movable mechanism in the area can be corrected regarding origin transaction 
data with sizes, in particular in connection with a robot, z. B. a 6-Achs-Knickarmroboter, for whose control are easily further-processable. 

In an arrangement for the determination of corrected transaction data for a course of motion of a movable mechanism after reference 
means necessary of the controlling of the movable mechanism not or not sufficiently seized movement z know. B. a three-dimensional 
object with orientation elements, z. B. Object edges or additionally attached marking elements, cover. In addition as reference means the 
virtual picture of such an three-dimensional object is possible, in particular in form of a hologram. With the reference means it depends 
crucial on the fact that in a given solid angle range clearly zuordenbare picture opinions of a picture version unit can be taken up. 



In a preferential execution form the picture version unit at the movable mechanism is arranged, against what the reference means are 
positioned separately from the movable mechanism. 



The allocation of picture version unit and reference means can be however also exchanged. In this case the reference means are 
appropriate at the movable mechanism, against what the picture version unit is arranged separately from the movable unit. 



If the picture version unit is positioned separately from the movable mechanism, it must be ensured that the graphic data reach one if 
necessary at the movable mechanism planned control computer always reliably. 

In both cases both the picture version unit and the reference means can be arranged movably at an admission. This presupposes however 
that the position during a spatial change of position of the reference means or the picture version unit with the computation of a 
transformation regulation for transaction data of the movable mechanism with are considered. 



During the mounting of the device for the determination of corrected transaction data at a movable mechanism, in particular at a mobile 
robot with a transport vehicle without driver and a manipulator, appropriate described above, at the transport vehicle the picture version 
system can be attached either at the transport vehicle without driver, at the manipulator or at a tool arranged at the manipulator. The 
mounting of the picture version unit at the manipulator is favourable if only a displaceable robot has to serve one or more stop act ions. In 
this case the picture version unit can be attached also at the transport vehicle, whereby the manipulator can be positioned then only in the 
context of its repetition accuracy. 



However several displaceable robots are used, all this on a set of tools (z. B. Grip arms or working on tools) to access are, are preferential 
it in the further one, if the picture version means are directly at the tool, in particular appropriate as additional picture version means. The 
accuracy is not impaired by this measure a repetition accuracy of the mechanical system of the manipulator limited by processing steps by 
or by the fact that the same tool is attached at different robots in if necessary easily differently out-arranged photographs. 



At the positions, which were just suggested for the picture version unit, can also instead the reference means to be positioned. In this case 
the picture version unit is to be attached separately from the movable mechanism preferably stationarily. 



Also according to invention a system of movable mechanisms, in particular displaceable robots, can be realized, with which itself the 
movable mechanisms respectively the robots z. B. at a multiplicity of different reference means or over several distribute arranged picture 
version units orient to be steered. 



The employment of the device for the determination of corrected transaction data for a course of motion of a movable mechanism, 
described above, is however not necessarily limited to displaceable robots exemplarily specified. Such a device can come also to the 
transaction data correction of linear axles or automatic Schwerlastkranen to the employment. Thereby for example positioning tolerances, 
which are actually not avoidable by the necessary mechanical elasticity of such mechanisms, can be corrected. 
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A remark example of the invention is represented and under indication of further advantages and details more near described in the 
designs. 



Fig. 1 a displaceable robot at a retaining station with a reference body in a schematic spatial representation and 



Fig. 2 a scrap view of the robot with reference body from diagonally down. 



Description of the remark example 



In Fig. 1 is represented a displaceable robot 1 before a retaining station 2. The displaceable robot covers a transport vehicle without driver 
3, on which a 6-Achs folding arm manipulator 4 is located. At the front end of the folding arm manipulator 4 a tool 5 is attached, with which 
workpieces can be taken up 6, which are removable stored at the retaining station 2 7 bars 8 attached on at a wall. 



At the top margin of the wall 7 an angular reference body is 9 with markings 10 (see. for this Fig. 2) positioned. At the tool 5 a digital 
camera 11 is installed. 



The transport vehicle without driver 3 knows z. B. by inductive guidance mechanisms (not represented) roughly before the retaining station 
2 to be positioned. At the retaining station 2 over the digital camera 11 a picture is taken up by the reference body 10. In the not 
represented computer unit by the data of the taken up picture of the reference body 10 and data of a reference picture of the reference 
means, with which the tool 5 would implement a trained movement accordingly from Urbewegungsdaten stored in the computer unit, a 
transformation regulation is calculated for the correction of the Urbewegungsdaten. With the application of this transformation regulation to 
the Urbewegungsdaten one receives corrected transaction data, by which a trained course of motion is then implemented ideally. 



By the markings the reference body within a certain solid angle range possesses 12 on the reference body 9 clearly zuordenbare picture 
opinions. This permits to win from the current picture of the reference body 9 after a rough positioning of the displaceable robot data which 
can be set clearly to data of a reference picture in purchase, in order from this the transformation regulation for the Urbewegungsdaten to 
the not represented computer to receive. Preferably for transformation a shift vector in a three-dimensional right-angled coordinate system 
is determined as well as three angle rotations around the axes of coordinates, which stretch the coordinate system. 



With this knowledge the tool 5 in different positions of the transport vehicle without driver can the workpieces 6 at the wall 7 over the 
manipulator 4 by in each case a transformation regulation which can be calculated again for a position of the transport vehicle without 
driver start, if necessary take up and if desired, on a prepared transportation range 12 beside the manipulator 4 at the transport vehicle 
without driver 3, z. B. on a not represented pallet, placing. Movements, which the tool 5 at the manipulator 4 exercises, always by shift 
vector and three angle rotations corrected, with which they finally with movements agree, which were trained in the position, in which the 
reference picture was taken up, the robot. 



By the determination of a transformation regulation in the three-dimensional area by only the admission of only one picture by means of an 
optical logging system, the z. B. to be rigidly appropriate to a tool or a manipulator, is not loaded the corrected course of motion can not by 
mechanical repeating inaccuracies, which arise if for example according to the DE 32 46 828 C2 the manipulator must move a plunger to 
the position collection if necessary three times to points of reference or an optical system has to start three points of reference. 



The accuracy of the corrected course of motion by the proceeding according to invention can be still further improved, by during a course of 
motion of the manipulator (z. B. while a working on tool is to be attached over the tool 5 of the manipulator 4 at a processing machine) the 
picture version fig. 11 photographs of the attachment place of the working on tool makes, whose compares data with the data of a well- 
known picture, with which the path admits to the attachment place accurately is and if necessary thereupon by the computer a position 
correction is made again, if by the data of the current picture and the data of the reference picture deviations are calculated. 



By the employment of a picture version fig. z. B. in form of a digital camera the system is also in a the position to implement an object 
recognition whereby the correcting device according to invention is supplied to an additional intended purpose. Normally an additional 
optical system at the robot must be planned for the supply of an object recognition, what increases the susceptibility of the system and 
drives finally the costs up. 



Reference symbol list 

1 displaceable robot 

2 retaining station 

3 transport vehicle without driver 

4 manipulator 

5 tool 

6 workpiece 

7 wall 

8 bar 

9 reference bodies 

10 marking 

11 digital camera 

12 transportation range 
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Die folgenden Angaben sind den vom Anmelder eingereichten Unterlagen entnommen 

Vorrichtung und Anordnung zur Ermittlung von korrigierten Bewegungsdaten fur einen vorgegebenen 
Bewegungsablauf einer bewegbaren Einrichtung sowie bewegbare Einrichtung und System aus bewegbaren 
Einrichtungen 

Es wird eine Vorrichtung zur Ermittlung von korrigier- 
ten Bewegungsdaten fur einen Bewegungsablauf einer 
bewegbaren Einrichtung (5) nach einer von der Steue- 
rung der bewegbaren Einrichtung (5) nicht ausreichend 
erfassten Bewegung der bewegbaren Einrichtung (5) vor- 
geschlagen. Der Erfindung liegt die Aufgabe zugrunde, 
die Ermittlung von korrigierten Bewegungsdaten fur ei- 
nen Bewegungsablauf einer bewegbaren Einrichtung ver- 
gleichsweise genauer und kostengunstiger vornehmen 
zu konnen. Zur Losung der Aufgabe umfasst die Vorrich- 
tung eine Bilderfassungseinheit (11) und eine Rechner- 
einheit, wobei die Rechnereinheit nach einer von der 
Steuerung der bewegbaren Einrichtung nicht oder nicht 
ausreichend erfassten Bewegung korrigierte Bewegungs- 
daten mit Hilfe von Bezugsmitteln (9) bestimmt, die we- 
nigstens in einem vorgegebenen Raumwinkelbereich ein- 
deutig zuordenbare Bildansichtenaufweisen, indem die 
Rechnereinheit aus Daten von einem durch die Bilderfas- 
sungseinheit (11) aufgenommenen Ist-Bild der Bezugs- 
mitte (9) nach der nicht oder unzureichend erfassten Be- 
wegung und Daten eines Bezugsbildes der Bezugsmittel 
(9), bei dem die bewegbare Einrichtung eine eingelernte 
Bewegung entsprechend von in der Rechnereinheit abge- 
legten Urbewegungsdaten ausfuhren wurde, eine Trans- 
formationsvorschrift zur Korrektur der Urbewegungsda- 
ten errechnet. Des Weiteren wird eine Anordnung zur Er- 
mittlung von korrigierten Bewegungsdaten fur einen Be- 
wegungsablauf einer bewegbaren Einrichtung mit Be- 
zugsmittel (9) ... 
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Beschreibung 

[0001] Die Erfindung betrifft eine Vorrichtung zur Ermitt- 
lung von korrigierten Bewegungsdaten fiir einen vorgegebe- 
nen Bewegungsablauf einer bewegbaren Einrichtung, z. B. 5 
eines verfahrbaren Roboters, eines Linearachsensystems 
usw., nach cincr von cincr Stcucrung dor bewegbaren Ein- 
richtung nicht oder nicht ausreichend erfassten Bewegung 
der bewegbaren Einrichtung, eine Anordnung, die eine sol- 
che Vorrichtung umfasst sowie eine bewegbare Einrichtung 10 
nach dem Oberbegriff des Anspruchs 1 und ein System aus 
mehreren bewegbaren Einrichtungen. 

Stand der Technik 

15 

[0002] Die deutsche Patentschrift DE 32 46 828 C2 offen- 
bart eine mobile Transport- und Handhabungseinrichtung, 
die aus einem automatisch steuerbaren, liniengebundenen 
und im Bereich von Haltestationen grob positionierbaren 
Flurlbrderfahrzeug sowie einem mit dem Flurforderfahr- 20 
zeug fest verbundenen Industrieroboter besteht, der durch 
einen Rechner gesteuert wird. Im Weiteren ist eine Messan- 
ordnung vorgesehen, deren Komponenten zum TeiL an der 
Einrichtung und zum Teil ortsfest im Bereich der Haltesta- 
tionen angebracht sind und durch welche nach der Positio- 25 
nierung der Einrichtung an der Halteposition die Abwei- 
chung der Ist-Position des Flurfdrderfahrzeugs von der Soll- 
Posilion crmiilclbar isl. Minds des Rechners erfolgt eine 
der Abweichung des Ist-Wertes vom Soll-Wert entspre- 
chendc 'lYanslbrnialion der Ilandhabungskoordinaien in der M< 
Robotersteuerung. 

[0003] Fiir die Ausgestaltung der Messanordnung sind 
eine Reihe von Ausfuhrungsvarianten in der 
DE32 46 828C2 beschrieben. BeispieLsweise weist die 
Messanordnung einen Taster mit einem Taststift auf, der am 35 
Greifer des Roboters angebracht und von diesem automa- 
lisch an orlslcsle Refcren/.punkle oder Flachcn heranfiihrbar 
ist. Durch das Antasten dieser Punkte oder der Flachen kann 
die Ist-Position der Einrichtung ermittelt werden. Des Wei- 
teren wird als Messanordnung ein Lichtsender, der einen ge- 40 
biindelten Lichtstrahl schrag auf eine reflektierende Mess- 
flache sendet sowie ein Lichtempfanger zur Aufnahme des 
reflektierten Strahls vorgeschlagen, wobei aus dem Auftreff- 
punkt des Strahls im Empfanger die Ist-Entfernung ermittel- 
barist. ' 45 

[0004] Die vollstandig mechanische Bestimmung der Ist- 
Position mittels des Greifers hat den Nachteil, dass die Posi- 
tion nur so genau bestimmt werden kann, wie es die Wieder- 
holgenauigkeit der Mechanik zulasst. 

[0005] Die optische Bestimmung der Ist-Position durch 50 
einen Lichtsender ist insofern nachteilig, als dass fiir eine 
dreidimensionale Erfassung der Position drei Messungen 
mit jeweils unterschiedlich positioniertem Sender notwen- 
dig sind, worunter wiederum die Genauigkeit der Positions- 
erfassung aufgrund einer begrenzten mechanischen Wieder- 55 
holgenauigkeit leidet. 

Aufgabe und Vorteile der Erfindung 

[0006] Der Erfindung liegt die Aufgabe zugrunde, die Er- 60 
mittlung von korrigierten Bewegungsdaten fiir einen Bewe- 
gungsablauf einer bewegbaren Einrichtung vergleichsweise 
genauer und kostengunstiger vornehmen zu konnen. 
[0007] Diese Aufgabe wird durch die Merkmale des An- 
spruchs 1, 6, 10 und 13 gelost. 65 
[0008] In den Unteranspriichen sind vorteilhafte und 
zweckmaBige Weiterbildungen der Erfindung angegeben. 
[0009] Die Erfindung geht zunachst von einer Vorrichtung 



zur Ermittlung von korrigierten Bewegungsdaten fur einen 
vorgegebenen Bewegungsablauf einer bewegbaren Einrich- 
tung, z. B. Elementen eines verfahrbaren Roboters oder ei- 
nes Systems, bestehend aus mehreren Linearachsen, nach 
einer von der Steuerung der bewegbaren Einrichtung nicht 
oder nicht ausreichend erfassten Bewegung der bewegbaren 
Einrichtung aus. Der Kcrngcdankc der Erfindung liegt nun 
darin, dass eine Bilderfassungseinheit und eine Rechnerein- 
heit vorgesehen sind und die Rechnereinheit nach einer von 
der Steuerung der bewegbaren Einrichtung nicht oder nicht 
ausreichend erfassten Bewegung die korrigierten Bewe- 
gungsdaten mit Hilfe von Bezugsmitteln bestimmt, die we- 
nigstens in einem vorgegebenen Raumwinkelbereich ein- 
deutig zuordenbare Bildansichten aufweisen, indem die 
Rechnereinheit aus Daten von einem durch die Bilderfas- 
sungseinheil aiifgenoninienen Ist-Bild der Bezugsniiltel im 
positionierten Zustand der bewegbaren Einrichtung nach der 
nicht oder unzureichend erfassten Bewegung und Daten ei- 
nes Bezugsbildes der Bezugsmittel, bei dem die bewegbare 
Einrichtung eine gewunschte Bewegung entsprechend von 
in der Rechnereinheit abgelegten Urbewegungsdaten aus- 
fiihren wiirde, eine Transformationsvorschrift zur Korrektur 
der Urbewegungsdaten errechnet. Durch diese Vorgehens- 
weise ist es moglich, durch eine einzige Bildaufnahme, die 
nicht oder nicht ausreichend erfasste raumliche Positionsan- 
derung einer bewegbaren Einrichtung an einer Messstelle 
exakt zu bestimmen. Fiir diese Messstelle, die einer grob an- 
gefahrenen Position entspricht, sind die diesbeziiglich er- 
mittelten Korrekturdaten fiir alle Urbewegungsdaten maB- 
geblich. D. h., die bewegbare Einrichtung kann an der Mess- 
stelle mit Urbewegungsdaten gewunschte Bewegungen 
durchfuhren, die lediglich einmal mit einer Transformati- 
onsvorschrift korrigiert werden miissen. Die in der 
DE 32 46 828 beschriebene optische Methode bedarf der 
Vermessung von mindestens drei verschiedenen Messstel- 
len, wodurch das Messergebnis von der Wiederholgenauig- 
keit des mechanischen Systems zum Anfahren dieser Mess- 
stellen nachteilig beeinflusst wird. Die erfindungsgemaBen 
MaBnahmen haben dariiber hinaus den weiteren Vorteil, 
dass sic sich in einer vergleichsweise deutlich kompakteren 
Rmilorm realisieren lassen. Des Weiteren ermoglicht. diese 
Art der Bewegungsdatenkorrektur mittels einer Bilderfas- 
sungseinheit den Einsatz derselben Bilderfassungseinheit 
und derselben Rechnereinheit zur Objekterkennung, wenn 
die Vorrichtung bei spiels weise an einem Roboter angeord- 
net ist, der z. B. vorgegebene Objekte greifen oder bearbei- 
ten soli. 

[0010] Wird die erfindungsgemaBe Vorrichtung zur Be- 
stimmung der raumlichen Position beispielsweise an einem 
verfahrbaren Roboter mit einem fahrerlosen Transportfahr- 
zeug und einem am Transportfahrzeug angebrachten Mani- 
pulator angeordnet, kann dieser Roboter nach einer Grobpo- 
sitionierung, z. B. fiber ein induktives Leitsystem, einge- 
lernte Bewegungsablaufe mil korrigierten Bewegungsdaten 
an der grob positionierten Stelle (Messstelle) dennoch exakt 
durchfuhren und zugleich mit Hilfe der Bilderfassungsein- 
heit, z. B. zu bearbeitende Werkstucke, identifizieren und 
gegebenenfalls in ihrer Lage erkennen. D. h., im Fall eines 
verfahrbaren Roboters mit Manipulator handelt es sich um 
eine bewegbare Einrichtung, namlich den Manipulator, die 
selbst nochmals bewegbar bzw. verfahrbar ist, denn der Ma- 
nipulator ist auf einem Transportfahrzeug montiert. Insbe- 
sondere in einer solchen Ausgestaltung ist die Erfindung 
vorteilhaft, da das Transportfahrzeug durch robuste, schnell 
arbeitende Positioniennittel. die vergleichsweise ungenau 
sein diirfen, an einen Einsatzort gebracht werden kann, wo- 
bei dann eine vergleichsweise hohe Genauigkeit der Bewe- 
gung des Manipulators durch die Anpassung der Urbewe- 
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gungsdaten des Manipulators auf den Einsatzort ilber die er- 
findungsgemaBe Korrektur erreicht wird. Das Transport- 
fahrzeug bleibt dabei unverandert in der grob angefahrenen 
Einsatzposition (Messstelle). Urn eine bestmogliche Kor- 
rektur der Bewegungsbahn eines am Manipulator angeord- 5 
neten Werkzeugs ohne mechanische Einflusse zu erhalten, 
wird vorgcschlagcn, die Bildcrfassungscinhcit odcr die Bc- 
zugsmittel direkt am Werkzeug zu positionieren. 
[0011] Zur Realisierung eines vergleichsweise kostengiin- 
stigen Aufbaus kann die Bilderfassungseinheit eine Video- 10 
kamera, insbesondere eine digitale Videokamera umfassen. 
Es kann jedoch auch eine analoge oder digitale Kamera ein- 
gesetzt werden. 

[0012] Als Rechnereinheit kann ein handelsiiblicher PC 
eingesetzt werden. 15 
[0013] Insbesondere beim Einsatz einer digitalen Video- 
kamera ist es bevorzugt, wenn die Rechnereinheit dazu aus- 
gelegt ist, die Transfonnationsvorschrift zur Korrektur der 
Bewegungsdaten durch einen Pixelvergleich des Ist-Bildes 
mit dem Bezugsbild zu bestimmen. Mit Hilfe der Transfer- 20 
mationsvorschrift kann dann z. B. ein Roboterarm, ausge- 
hend von Ursprungsbewegungsdaten, auch nach einer von 
einer Steuerung des Roboters nicht erfassten Bewegung des 
Roboterarms anhand von korrigierten Bewegungsdaten den- 
noch in exakter Weise vorgegebene Bewegungsablaufe 25 
durchfiihren. 

[0014] Vorzugsweise ist die Rechnereinheit zur Ermitt- 
lung einer Transfonnationsvorschrift in Form eines Ver- 
schiebungsvektors in einem dreidimensionalen Koordina- 
icnsyslcm sowie von Winkeldrchnngen uni die drei Koordi- 
natenachsen ausgelegt, die das Koordinatensystem aufspan- 
nen. Durch den Verschiebungsvektor und jcweiligen Dreh- 
winkel lasst sich die Bewegung einer bewegbaren Einrich- 
tung im Raum in Bezug an! Ursprungsbewegungsdaten mil 
GroBen korrigieren, die insbesondere ini Zusammenhang 35 
mit einem Roboter, z. B. einem 6-Achs-Knickarmroboter, 
fur dessen Ansteuerung leicht weiterverarbeitbar sind. 
[0015] Die in einer Anordnung zur Ennittlung von korri- 
gierten Bewegungsdaten fur einen Bewegungsablauf einer 
bewegbaren Einrichtung nach einer von der Steuerung der 40 
bewegbaren Einrichtung nicht oder nicht ausreichend er- 
fassten Bewegung notwendigen Bezugsmittel konnen z. B. 
ein dreidimensionales Objekt mit Orientierungselementen, 
z. B. Objektkanten oder zusatzlich angebrachte Markie- 
rungselementen, umfassen. Als Bezugsmittel ist auBerdem 45 
das virtuelle Bild eines solchen dreidimensionalen Objekts 
moglich, insbesondere in Form eines Hologramms. Bei den 
Bezugsmitteln kommt es entscheidend darauf an, dass in ei- 
nem vorgegebenen Raumwinkelbereich eindeutig zuorden- 
bare Bildansichten von einer Bilderfassungseinheit aufge- 50 
nommen werden konnen. 

[0016] In einer bevorzugten Ausfuhrungsform ist die 
Bilderfassungseinheit an der bewegbaren Einrichtung ange- 
ordnet, wogegen die Bezugsmittel getrennt von der beweg- 
baren Einrichtung positioniert sind. 55 
[0017] Die Zuordnung von Bilderfassungseinheit und Be- 
zugsmittel kann jedoch auch vertauscht werden. In diesem 
Fall sind an der bewegbaren Einrichtung die Bezugsmittel 
angebracht, wogegen die Bilderfassungseinheit getrennt von 
der bewegbaren Einheit angeordnet ist. 60 
[0018] Fur den Fall, dass die Bilderfassungseinheit ge- 
trennt von der bewegbaren Einrichtung positioniert ist, muss 
gewahrleistet werden, dass die Bilddaten einen gegebenen- 
falls an der bewegbaren Einrichtung vorgesehenen Steuer- 
rechner immer sicher erreichen. 65 
[0019] In beiden Fallen konnen sowohl die Bilderfas- 
sungseinheit als auch die Bezugsmittel bewegbar an einer 
Aufnahme angeordnet werden. Dies setzt jedoch voraus, 



dass die Position bei einer raumlichen Positionsanderang 
der Bezugsmittel oder der Bilderfassungseinheit bei der Be- 
rechnung einer Transfonnationsvorschrift fur Bewegungs- 
daten der bewegbaren Einrichtung mit beriicksichtigt wer- 

[0020] Bei der Anbringung der oben beschriebenen Vor- 
ricbtung zur Ermittlung von korrigierten Bewegungsdaten 
an einer bewegbaren Einrichtung, insbesondere an einem 
fahrbaren Roboter mit einem fahrerlosen Transportfahrzeug 
und einem am Transportfahrzeug angebrachten Manipulator 
kann das Bilderfassungssystem entweder am fahrerlosen 
Transportfahrzeug, am Manipulator oder an einem am Ma- 
nipulator angeordneten Werkzeug angebracht werden. Die 
Anbringung der Bilderfassungseinheit am Manipulator ist 
dann vorteilhaft, wenn nur ein verfahrbarer Roboter eine 
oder niehrere Ilalleslaliuncn /,u bedienen hat. In diesem Fall 
kann die Bilderfassungseinheit auch am Transportfahrzeug 
selber angebracht werden, wobei sich der Manipulator dann 
nur im Rahmen seiner Wiederholgenauigkeit positionieren 
lasst. 

[0021] Werden jedoch mehrere verfahrbare Roboter ein- 
gesel/.l. die aiie anfeine Peine von Wcrk/.euge (/.. 11 ( Ireiler 
oder Bearbeitungswerkzeuge) zugreifen sollen, ist es im 
Weileren bevor/.ugt, wenn die BilderfassungsmiUel unniil- 
telbar am Werkzeug, insbesondere als zusatzliche Bilderfas- 
sLingsniittel angebracht sind. Durch diese MaBnahme wird 
die Genauigkeil von Arbeitsgangen nicht durch eine be- 
grenzte Wiederholgenauigkeit des mechanischen Systems 
des Manipulators oder dadurch beeintrachtigt, dass das 
selbe Werkzeug an verschiedenen Robotern in gegebenen- 
falls leicht unterschiedlich ausgestalteten Aufnahmen ange- 
bracht ist. 

[0022] An den Positionen, die soeben fur die Bilderfas- 
sungseinheil vorgeschkigen wurden, konnen auch slalldes- 
sen die Bezugsmittel positiotiiert werden. In diesem Fall ist 
die Bilderfassungseinheit getrennt von der bewegbaren Ein- 
richtung vorzugsweise ortsfest anzubringen. 
[0023] ErfindungsgemaB kann auch ein System bewegba- 
rer Einrichtungen, insbesondere verfahrbare Roboter, reali- 
siert werden, bei welchem sich die bewegbaren Einrichtun- 
gen respective die Roboter z. B. an einer Vielzahl von unter- 
schiedlichen Bezugsmitteln orientieren oder uber mehrere 
verteilt angeordnete Bilderfassungseinheiten gesteuert wer- 
den. 

[0024] Der Einsatz der oben beschriebenen Vorrichtung 
zur Ermittlung von konigierten Bewegungsdaten fur einen 
Bewegungsablauf einer bewegbaren Einrichtung ist jedoch 
nicht notwendigerweise auf beispielhaft genannte verfahr- 
bare Roboter beschrankt. Eine solche Vorrichtung kann auch 
zur Bewegungsdatenkorrektur von Linearachsen oder auto- 
matischen Schwerlastkranen zum Einsatz kommen. Hier- 
durch lassen sich beispielsweise Positioniertoleranzen, die 
durch die notwendige mechanische Elastizitat solcher Ein- 
richtungen an sich nicht vermeidbar sind, korrigieren. 

Zeichnungen 

[0025] Ein Ausfuhrungsbeispiel der Erfindung ist in den 
Zeichnungen dargestellt und unter Angabe weiterer Vorteile 
und Einzelheiten naher erlautert. 
[0026] Es zeigen 

[0027] Fig. 1 einen verfahrbaren Roboter an einer Halte- 
station mit einem Bezugskorper in einer schematischen 
raumlichen Darstellung und 

[0028] Fig. 2 eine Teilansicht des Roboters mit Bezugs- 
korper von schrag unten. 
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Beschreibung des Ausfiihrungsbeispiels 

[0029] In Fig. 1 ist ein verfahrbarer Roboter 1 vor einer 
Haltestation 2 dargestellt. Der verfahrbare Roboter umfasst 
ein fahrerloses Transportfahrzeug 3, auf dem ein 6-Achs- 5 
Knickarmmanipulator 4 angeordnet ist. Am vorderen Ende 
dcs Knickarmmanipulators 4 ist cin Wcrkzcug 5 angcbracht, 
mit welchem Werkstiicke 6 aufgenommen werden konnen, 
die an der Haltestation 2 auf an einer Wand 7 angebrachten 
Stangen 8 abnehmbar gelagert sind. 10 
[0030] Am oberen Rand der Wand 7 ist ein winkelformi- 
ger Bezugskorper 9 mit Markierungen 10 (vgl. hierzu Fig. 
2) positioniert. Am Werkzeug 5 ist eine Digitalkamera 11 
montiert. 

[0031] Das fahrerlose Transportfahrzeug 3 kann z. B. 15 
durch induktive Leiteinrichtungen (nicht dargestellt) grob 
vor der Haltestation 2 positioniert werden. An der Haltesta- 
tion 2 wird iiber die digitale Kamera 11 ein Bild vom Be- 
zugskorper 10 aufgenommen. Tn der nicht dargestellten 
Rechnereinheit wird aus den Daten des aufgenommenen 20 
Bildes des Bezugskorpers 10 und Daten eines Bezugsbildes 
der Bezugsmittel, bei dem das Werkzeug 5 eine eingelernte 
Bewegung entsprechend von in der Rechnereinheit abgeleg- 
ten Urbewegungsdaten ausfiihren wiirde, eine Transformati- 
onsvorschrift zur Korrektur der Urbewegungsdaten errech- 25 
net. Bei der Anwendung dieser Transfonnationsvorschrift 
auf die Urbewegungsdaten erhiill man korrigicrte Bewe- 
gungsdaten, durch die dann ein eingelcrntcr Bewegungsab- 
lauf ideal ausgefiihrt wird. 

[0032] Durch die Markierungen 12 auf dem Bezugskorper 30 
9 besitzt der Bezugskorper in einem bestimmten Raumwin- 
kelbereich eindeutig zuordenbare Bildansichten. Dies er- 
laubt dem nicht dargestellten Rechner, aus dem aktuellen 
Bild des Bezugskorpers 9 nach einer groben Positionierung 
des verfahrbaren Roboters Daten zu gewinnen, die eindeutig 35 
zu Daten eines Bezugsbildes in Bezug gesetzt werden kon- 
nen, um hieraus die Transformationsvorschrift fur die Urbe- 
wegungsdaten zu erhalten. Vorzugsweise wird zur Transfor- 
mation ein Verschiebungsvektor in einem dreidimensiona- 
len rechtwinkligen Koordinatensystem ermittelt sowie drei 40 
Winkeldrehungen um die Koordinatenachsen, welche das 
Koordinatensystem aufspannen. 

[0033] Mit dieser Kenntnis kann das Werkzeug 5 in unter- 
schiedlichen Positionen des fahrerlosen Transportfahrzeugs 
iiber den Manipulator 4 durch eine jeweils fur eine Position 45 
des fahrerlosen Transportfahrzeugs neu zu errechnende 
Transformationsvorschrift die Werkstiicke 6 an der Wand 7 
anfahren, gegebenenfalls aufnehmen und falls gewiinscht, 
auf einem vorbereiteten Transportbereich 12 neben dem 
Manipulator 4 am fahrerlosen Transportfahrzeug 3, z. B. auf 50 
einer nicht dargestellten Palette, ablegen. Dabei werden die 
Bewegungen, die das Werkzeug 5 am Manipulator 4 ausiibt, 
immer durch den Verschiebungsvektor und die drei Winkel- 
drehungen korrigiert, womit sie letztendlich mit Bewegun- 
gen ubereinstimmen, die in der Stellung, in welcher das Be- 55 
zugsbild aufgenommen wurde, dem Roboter eingelernt wor- 
den sind. 

[0034] Durch die Ermittlung einer Transformationsvor- 
schrift im dreidimensionalen Raum durch lediglich die Auf- 
nahme eines einzigen Bildes mittels eines optischen Erfas- 60 
sungssy stems, das z. B. starr an einem Werkzeug oder Mani- 
pulator angebracht sein kann, ist der korrigierte Bewegungs- 
ablauf nicht durch mechanische Wiederholungenauigkeiten 
belastet, die dann auftreten, wenn beispielsweise entspre- 
chend der DE 32 46 828 C2 der Manipulator zur Positions- 65 
erfassung einen Taststift gegebenenfalls dreimal an Refe- 
renzpunkte bewegen muss oder ein optisches System drei 
Referenzpunkte anzufahren hat. 



624 Al 

6 

[0035] Die Genauigkeit des korrigierten Bewegungsab- 
laufs durch die erfindungsgemaBe Vorgehensweise kann 
noch weiter verbessert werden, indem wahrend eines Bewe- 
gungsablaufs des Manipulators (z. B. wahrend ein Bearbei- 
tungswerkzeug iiber das Werkzeug 5 des Manipulators 4 an 
einer Bearbeitungsmaschine angebracht werden soil) die 
Bildcrfassungscinhcit 11 Aufnahmcn vom Anbringungsort 
des Bearbeitungswerkzeugs macht, dessen Daten mit den 
Daten eines bekannten Bildes vergleicht, bei welchem die 
Bewegungsbahn zum Anbringungsort exakt bekannt ist und 
gegebenenfalls daraufhin vom Rechner nochmals eine Posi- 
tionskorrektur vorgenommen wird, falls aus den Daten des 
aktuellen Bildes und den Daten des Bezugsbildes Abwei- 
chungen errechnet werden. 

[0036] Durch den Einsatz einer Bilderfassungseinheit 
z. B. in Form einer digitalen Kamera ist das System auch in 
der Lage, eine Objekterkennung auszufiihren, wodurch die 
erfindungsgemaBe Korrigiervorrichtung einem zusatzlichen 
Verwendungszweck zugefiihrt wird. Normalerweise muss 
zur Bereitstellung einer Objekterkennung ein zusatzliches 
optisches System am Roboter vorgesehen werden, was die 
Anfalligkeit des Systems erhoht und letztendlich die Kosten 
in die Hohe treibt. 

Bezugszeichenliste 

1 verfahrbarer Roboter 

2 Haltestation 

3 fahrerloses Transport fahr/eug 

4 Manipulator 

5 Werkzeug 

6 Werkstuck 

7 Wand 

8 Stange 

9 Bezugskorper 

10 Markierung 

11 Digitalkamera 

12 Transportbereich 

Patentanspriiche 

1 . Vorrichtung zur Ermittlung von korrigierten Bewe- 
gungsdaten fur einen vorgegebenen Bewegungsablauf 
einer bewegbaren Einrichtung (5) nach einer von einer 
Steuerung der bewegbaren Einrichtung nicht oder nicht 
ausreichend erfassten Bewegung der bewegbaren Ein- 
richtung (5), dadurch gekennzeichnet, dass eine Bild- 
erfassungseinheit (11) und eine Rechnereinheit vorge- 
sehen sind, und die Rechnereinheit nach der von der 
Steuerung der bewegbaren Einrichtung nicht oder nicht 
ausreichend erfassten Bewegung korrigierte Bewe- 
gungsdaten mit Hilfe von Bezugsmitteln (9) bestimmt, 
die wenigstens in einem vorgegebenen Raumwinkelbe- 
reich eindeutig zuordenbare Bildansichten aufweisen, 
indem die Rechnereinheit aus Daten von einem durch 
die Bilderlassungseinheit (11) aufgenommenen Ist- 
Bild der Bezugsmittel (9) im positionierten Zustand der 
bewegbaren Einrichtung (5) nach der nicht oder unzu- 
reichend erfassten Bewegung und Daten eines Bezugs- 
bildes der Bezugsmittel (9), bei dem die bewegbare 
Einrichtung eine gewiinschte Bewegung entsprechend 
von in der Rechnereinheit abgelegten Urbewegungsda- 
ten ausfiihren wiirde, eine Transformationsvorschrift 
zur Korrektur der Urbewegungsdaten errechnet. 

2. Vorrichtung nach Anspruch 1, dadurch gekenn- 
zeichnet, dass die Bilderfassungseinheit eine Kamera 
oder eine Videokamera (11) umfasst. 

3. Vorrichtung nach Anspruch 1 oder 2, dadurch ge- 
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kennzeichnet, dass die Rechnereinheit ein handelsiibli- 

4. Vorrichtung nach einem der vorhergehenden An- 
spriiche, dadurch gekennzeichnet, dass die Rechnerein- 
heit dazu ausgelegt ist, die Transformationsvorschrift 5 
durch einen Pixel- Vergleich des Ist-Bildes mit dem Be- 
zugsbild zu bcstimmcn. 

5. Vorrichtung nach einem der vorhergehenden An- 
spriiche, dadurch gekennzeichnet, dass die Rechnerein- 
heit zur Ermittlung einer Transformationsvorschrift in 10 
Form eines Verschiebungsvektors in einem dreidimen- 
sionalen Koordinatensystem sowie von Winkeldrehun- 
gen um die drei Koordinatenachsen ausgelegt ist, die 
das Koordinatensystem aufspannen. 

6. Anordnung zur Ermittlung von korrigierten Be we- 15 
gungsdaten fur einen Bewegungsablauf einer beweg- 
baren Einrichtung (5) mit einer Vorrichtung nach ei- 
nem der vorhergehenden Anspriiche sowie mit Bezugs- 
mittel (9), die wenigstens in einem vorgegebenen 
Raumwinkelbereich eindeutig zuordenbare Bildan- 20 
sichten aufweisen. 

7. Anordnung nach Anspruch 6, dadurch gekennzeich- 
net, dass die Bezugsmittel ein dreidimensionales Ob- 
jekt mit Orientierungselementen oder dessen virtuelles 
Bild umfassen. 25 

8. Anordnung nach Anspruch 6 oder 7, dadurch ge- 
kennzeichnet, dass die Bezugsmittel (9) an derbeweg- 
baren Einrichtung (5) und die Bilderfassungseinheit 
(11) getrennt von der bewegbaren Einrichtung (5) an- 
geordnet ist. 30 

9. Anordnung nach einem der vorhergehenden An- 
spriiche 6 bis 8, dadurch gekennzeichnet, dass die Bild- 
erfassungseinheit (11) an der bewegbaren Einrichtung 
(5) und die Bezugsmittel (9) getrennt von der bewegba- 
ren Hinricluung i5) angeordnel sind. 35 

10. Bewegbare Einrichtung, insbesondere verfahrbare 
Roboter mit einem fahrerlosen Transportfahrzeug (3) 
und einem am Transportfahrzeug angebrachten Mani- 
pulator (4), dadurch gekennzeichnet, dass zur Ermitt- 
lung von korrigierten Bewegungsdaten fur die beweg- 40 
bare Einrichtung (5) nach einer von der Steuerung der 
bewegbaren Einrichtung nicht oder nicht ausreichend 
erfassten Bewegung eine Vorrichtung nach einem der 
Anspriiche 1 bis 5 vorgesehen ist. 

11. Bewegbare Einrichtung nach Anspruch 10, da- 45 
durch gekennzeichnet, dass die Bezugsmittel (9) an der 
bewegbaren Einrichtung (5) angeordnet sind. 

12. Bewegbare Einrichtung nach Anspruch 10 oder 
11, dadurch gekennzeichnet, dass die Bilderfassungs- 
einheit (11) an der bewegbaren Einrichtung (5) ange- 50 
ordnet ist. 

13. System aus mehreren bewegbaren Einrichtungen, 
insbesondere verfahrbaren Robotern, gemaB einem der 
Anspriiche 10 bis 11 sowie mehreren Bezugsmittel (9) 
oder Bilderfassungseinheiten (11). 55 
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